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ZMTRODUCTION 

The  objective  of  the  Army  Research  Office  (ARO)  robotics  project 
is  to  design  and  control  a  relatively  lightweight  elastic  three- 
linked  robot  with  defined  paths  of  motion  to  carry  an  object  load 
at  least  equal  to  its  own  weight.  This  study  is  supported  at  the 
University  of  Nevada,  Las  Vegas  (UNLV)  by  the  U.S.  ARO  under  grant 
No.  DAAL03-87-G-0004 .  A  static  and  quasi  dynamic  mathematical 
model  of  the  robot  manipulator  was  derived  [Ladkany,  S.G.  and 
Bonnoura,  T.M,  1990]  using  the  theory  of  structures  and  the  fourth 
order  differential  equations  of  slender  beams.  The  model  gives  the 
three  displacements  and  the  three  rotations  of  the  end  effector  due 
to  static  and  quasi  dynamic  load  vectors  and  moment  vectors  applied 
to  the  end  effector  and  the  centers  of  gravities  of  the  links.  The 
model  was  used  in  the  design  of  the  steel  manipulator,  the  study 
of  which  is  the  subject  of  this  research.  It  is  believed  that  the 
results  presented  in  this  paper  will  expand  existing  robot 
kinematics  and  dynamic  theory  that  include  the  effects  of 
elasticity  and  active  damping. 

A  major  disadvantage  in  designing  an  elastic  lightweight 
manipulator  is  the  vibrational  problems  associated  with  the 
flexibility  of  the  link  members  (Geradin  and  Berardin,  1984,  Koren, 
1985) .  In  this  research,  link  2  &  3  of  the  thin,  flexible  steel 
robot  are  elastic  and,  therefore,  subject  to  various  modes  of 
vibrations  due  to  imposed  loads.  Because  of  the  possible  large 
amplitudes  of  vibration  which  may  occur,  active  damping  methods 
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control  of  the  manipulator.  To  solve  the  vibrational  problems,  the 
use  of  active  damping  methods  in  conjunction  with  path-motion 
studies  are  under  consideration  in  the  design  of  the  controller. 
The  control  technique  concentrated  on  in  this  research,  will  be 
that  of  positioning  strain  gages  at  certain  defined  locations  on 
each  link  in  conjunction  with  angular  encoder  sensors  at  each  joint 
to  ultimately  define  kinematically  the  position  of  the  end  effector 
in  space  and  time.  The  strain  gages  are  connected  to  Wheatstone 
bridge  amplification  circuitry,  which  are  connected  in  turn  through 
an  A-0  board  to  micro-computers.  The  stain  gage  data  and  angular 
encoder  sensor  data  are  read  into  a  FORTRAN  program  code  utilizing 
Lagrange  polynomials  and  shape  functions  developed  to  convert  the 
strain  gage  readings  and  the  angular  encoder  sensor  readings  into 
joint  displacements.  The  axial,  flexural,  and  rotational  Lagrange 
polynomial  displacement  equations  describe  the  deflected  shape  of 
each  link  in  its  local  coordinate  system  as  a  function  of  the 
strain  gage  readings,  their  location  x  along  the  link,  and  time  t. 
From  the  rotational  displacement  at  a  rigid  joint,  the  rigid  body 
rotation  of  the  connected  link  is  determined.  Torsional 
displacements  are  determined  from  multiple  strain  gage  elsmenrs 
known  as  rosettes.  The  rosettes  are  located  on  each  link  of 
robotic  model,  and  measure  torsional  shearing  strain  in  the  links 
caused  by  an  external  torque  in  the  direction  of  the  local  axis  of 
the  link.  A  slight  twist  of  torsional  strain  in  one  link  will 
result  in  a  rotational  displacement  of  the  joint  connecting  the  two 
links.  This,  in  turn,  results  in  a  rigid  body  out  of  plane 
rotation  of  the  next  link  affecting  the  final  location  of  the  end 
effector.  Once  the  local  displacements  are  known,  they  are 
transformed  into  global  displacements  to  be  used  by  the  controller. 
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Flexible  Robot  Manipolator  Displacements 

1. Displacement  Equations  Using  Strain  Gages  and  Lagrange 
Polynomials 

The  deflected  and  rotated  position  of  the  end  effector  in  the 
global  coordinate  system  required  for  ultimate  control  of  the  robot 
will  be  determined  from  the  local  deflections  and  rotations  of 
links  2  &  3  and  all  associated  rigid  body  motions  of  the 

manipulator  arm  (figures  5,6,7,8,9,&10) .  Strain  gages  are  used  to 
measure  experimentally  the  suueimum  eucial  strains  on  all  four 
orthogonal  surfaces  at  three  specific  locations  in  the  direction  of 
the  local  'x-axis  of  link  2  and  link  3.  It  is  to  be  noted  that 
strains  measured  along  the  faces  of  IjjJrs  2  and  3,  due  to  flexural 
bending  alone,  are  of  opposite  signs.  By  using  the  Lagrange 
interpolation  formula,  a  shape  function  is  developed  from  these 
strain  measurements  which  directly  describes  the  strain  at  any 
point  'x  along  the  local  'x-axis  of  each  link.  The  bar  -  notation 
above  the  strain  symbol  e,  defines  a  typical  individual  strain 
value  at  a  face  of  a  particular  link  member.  All  strain  values  are 
considered  positive  if  tensile  in  nature  and  negative  if 
compressive  in  nature.  The  superscript  i  in  the  notation  defines 
the  link  number  as  shown  below: 

i«2  for  link  2  emd  3  for  link  3.  (1) 

Lagrange  polynomials  are  used  to  describe  the  axial  strain  ’*6^  and 
then  to  use  these  polynomials  to  develop  displacement  equations  to 
describe  the  deflected  shape  of  link  2  and  3  in  their  respective 
local  coordinate  systems.  From  these  displacement  equations,  the 
displacements  at  the  jointed  ends  of  link  2  and  link  3  are  deter¬ 
mined.  The  displacements  of  interest  to  be  determined  are: 
three  translational  'u,  'v  and  'w,  three  rotational  '9^,  '9^  and  '9, 
and  all  rigid  body  motion  effects  associated  with  these  dis¬ 
placements.  The  three  translational  displacements  are  in  the 
direction  of  the  'x,  'y  and  'z  local  axes  respectively  (figure  5  i 
6)  .  The  three  rotational  displacements  are  defined  by  the 

subscripts  x,  y,  and  z  which  indicate  the  local  axes  about  which 
the  rotational  displacements  occur  (figure  5  &  6)  .  After  all  local 
displacements  for  links  2  and  3  are  determined,  the  position  of  the 
end  effector  in  global  coordinates  X,  Y,  and  Z  are  found  by 
coordinate  transformation. 

It  is  to  be  noted  that  the  strain  and  displacement  polynomials 
developed  here  are  a  function  of  'x  and  time  t,  where  'x  is  the 
dimension  along  the  local  'x-axis  from  the  clamped  end  of  the  link, 
and  t  is  a  time  parameter  relative  to  a  set  initial  time.  In  order 
to  simplify  all  further  notation,  it  is  to  be  understood  from  this 
point  on  that  all  equations  developed  are  a  function  of  x  and  t. 

The  structural  design  of  the  robotic  links  [ Ladkany/ Bannoura , 
1988]  limited  the  maximum  allowable  stresses  calculated,  for  the 
worst  loading  condition,  to  a  value  below  the  yield  stress  of  the 
material.  Therefore,  all  stress-strain  beam  equations  which  apply 
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within  the  elastic  range  of  the  materiail  will  be  valid  here.  The 
stress-strain  beam  equations  developed  are  based  upon  linearized 
theory  and  the  following  assumptions: 

a 

€  - ,  (Hooke's  law)  (2) 

E 

T 

Y  - - ,  (Hooke's  law  for  shearing  strain)  (3) 

G 

F 

€  - - ,  (axial  strain)  (4) 

AE 

He 

€  — — ,  (bending  strain)  (5) 

El 


X 

Y^  - - ,  (torsional  strain)  '6} 

JG 

where : 

£  Indicates  axial  strain. 

£^  Indicates  maximum  strain  at  the  extreme  fiber. 

a  Indicates  axial  stress. 

Y  Indicates  shear  strain. 

Y^  Indicates  maximum  shearing  strain  at  the  extreme  fiber. 

r  Indicates  shear  stress. 

A  Cross-sectional  Area. 

c  Distance  from  the  neutral  axis  to  the  extreme  fiber  of 

the  beam. 

E  Defines  the  Modulus  of  Elasticity. 

F  Axial  force. 

G  Defines  the  Shearing  Modulus  of  Elasticity. 

I  Defines  the  Moment  of  Inertia  of  the  beam  cross  section. 

J  Defines  the  polar  Moment  of  Inertia. 

M  Defines  the  moment  value  about  the  y  and  z  axis  at  the 

point  under  consideration. 

Torsional  Moment  about  local  x-axis. 

Link  2  and  link  3  are  connected  to  the  manipulator  via  rigid 
joints;  they  deflect  under  loading  in  the  orthogonal  planes  as 
cantilever  beams  clamped  at  one  end  in  their  respective  local 
coordinate  systems.  As  shovm  in  (figure  1)  link  2  is  considered 
clamped  at  joint  B  and  link  3  is  considered  clamped  at  joint  2, 
however,  link  2  and  3  are  hinged  together  in  the  'x'y.  plane  and 
rigidly  attached  together  in  the  'x'z  plane.  The  local  'x  axis  has 
an  origin  at  joint  B  for  link  2  and  an  origin  at  joint  2  for  link 

3.  Based  on  this  assumption  the  local  boundary  conditions  at  'x=0 

for  link  2  and  link  3  are  noted  below: 

9  'x*o 

'u-o,  'v«o,  'w*o,  '6,  »o,  i0^  »o,  i0-  »o 
®  ®  ®  *0^0*0 


(7) 
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The  proper  interfacing  of  the  pertinent  strain  gage  sets  in 
imperative  for  calculation  of  the  correct  displacements  at  any 
point  'x  along  link  2  and  link  3.  Therefore,  the  first  part  of 
this  section  is  devoted  to  clarification  of  the  locations  and 
orientations  of  the  strain  gages  employed.  On  each  line  (link  2  & 
3)  there  are  four  sets  of  strain  gages  mounted  (figure  2  and  3a  & 
b) .  The  first  three  sets  on  each  link  are  made  up  of  four  single 
element  gages,  and  the  fourth  set  is  made  up  of  two  three  element 
rosette  strain  gages. 


The  first  three  sets  have  one  gage  mounted  on  each  face  of  the 
steel  tube  at  the  same  location  '(Xj^}  from  the  clamped  end.  The 
general  notation  used  in  this  thesis  to  define  the  first  three 
strain  gage  sets  is  shown  below: 


where : 

i  Defines  the  link  ntmber  (i»2  or  3)  . 

j  Refers  to  the  strain  gage  sets  1,2  and  3  (figure  2  and 

3a)  ,  where  set  1  is  at  location  'x.,  set  2  is  at  location 
'Xj,  and  set  three  is  at  location  ^x,. 
t  Is  an  integer  which  refers  to  the  correct  strain  gage 

combination  from  the  positions  noted  (figxure  3b) . 


Note: 


e«l  Combined  strain  gages  readings  from  positions  1,2,3  &  4. 

Combined  strain  gage  readings  from  positions  1  &  3 . 
f =3  Combined  strain  gage  readings  from  positions  2  &  4 . 


The  forth  set  on  each  link  has  one  rosette  on  the  positive  'y- 
face  and  negative  'y-face  of  link  2  and  3  at  an  arbitrary  location 
'Xj  (figure  2  and  2a)  .  The  exact  location  of  the  fourth  set  is  not 
required  since  the  torsion  strain  is  constant  throughout  t.he  length 
of  each  link.  The  general  notation  used  in  this  thesis  to  define 
the  fourth  strain  gage  set  for  link  2  and  3  is  shown  below: 


Where: 


(9) 


f  Is  an  angle  in  the  plane  of  the  rosette  (figure  4) . 

§  Refers  to  the  strain  gage  combinations  required  for 

temperature  compensation  to  be  defined  more  clearly  in 
section  1.4. 


A  general  polynomial  which  describes  the  axial  strain  along 
the  local  x>axis  is: 

'■£  (x,t)»»''Cjj»a^+a2'x+a3'x^+  —  +a^'x"'’  (10) 

In  the  analysis,  Lagrange  polynomials  will  be  used  to  describe 
the  deformed  shape  of  the  manipulator  links  2  and  3  using  the 
strain  gages.  If  these  polynomials  are  to  describe  the  static 
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deformed  shape  of  the  links  exactly,  the  polynqmials  must  have  an 
order  at  least  equal  to  the  highest  order  in  'x  required  for  the 
theoretical  deflection  equations  associated  with  the  desired 
loading  condition.  It  is  assumed  that  the  highest  degree  loading 
condition  the  link  members  may  experience  is  that  of  a  uniform  load 
q  (such  as  their  own  weight  per  linear  'x  dimension)  ,  Which  leads 
to  a  fourth  order  polynomial.  In  general,  from  beam  theory  for  a 
uniform  load  condition,  the  displacement  equation  which  results  in 
the  highest  order  in  'x  is  the  bending  displacement  equation,  which 
is  termed  A.  The  theoretical  bending  displacement  equarion  from 
beam  theory  for  a  cantilever  beam,  where  x  is  measured  from  the 
clamped  end,  is  noted  below  [AISC,  1980]: 


q  ( 4 'xL^-6 '  x2l2+4 'Vl-'x^) 

24EI 

where : 

L  Defines  the  length  of  a  typical  cantilever  beam, 

q  Defines  a  uniform  distributed  loading. 

From  the  equation  above  it  can  be  seen  that  a  fourt.".  order 
Lagrange  polynomial  in  'x  is  required  to  exactly  describe  the 
static  bending  deformation  of  link  No. 2  and  link  No. 3  for  this  type 
of  loading  condition.  Beam  curvature  is  defined  as  the  second 
derivative  of  the  displacement  equation  'A  with  respect  to  'x.  The 
beam  curvattire  is  related  to  the  maximum  axial  strain  ^iong 

the  local  ‘x-axis  at  the  cuetreme  fiber  of  the  link  member  as  shown 
below: 


d2‘A 

M 

2*max 

^•xmax 

d‘x2 

El 

Eh 

h 

where : 

h  Defines  the  out-to-out  dimension  of  the  link  member 

cross  section. 

Defines  the  maximum  stress  along  the  local  x-axis  at  the 
extreme  fiber  of  the  steel  tube. 

In  order  to  determine  the  exact  static  displacement  equation 
'A,  a  Lagreuige  polynomial  which  describes  the  strain  must  be  at 
least  second  order  in  'x  (n"3) .  by  integrating  twice,  the  second 
order  strain  polynomial  in  'x  becomes  a  fourth  o:^er  polynomial  in 
'x  and  thus  defines  the  displacement  equation  'A.  The  Lagrange 
polynomial  required  to  develop  all  of  the  displacement  equations 
desired  here  is: 

‘■€,»‘a^+‘a2'x+'a3’V  (13) 

To  derive  a  second  order  polynomial  in  'x,  that  defines  the 
strain  as  a  shape  function,  a  Lagrange  polynomial  is  used  in  terms 
of  the  strain  values.  Lagrange's  interpolation  formula  [Cook, 
1981]  used  to  define  the  axial  strain  as  a  polynomial  in  terms 
of  a  shape  function  'L  nJ  is  noted  below: 

Mi  ',(£;) 


where : 


(14) 


tcgi-Bse-? 


The  strain  values  \{e.)  as  defined  above  in  equation  (8)  are 
strain  measurements  determined  experimentally  by  placing  three 
single  element  strain  gages  orientated  along  the  local  'x-axis  of 
each  link  (figure  2  and  3  a)  and  located  at  'x.,,  'x^  and  'X3 
respectively.  The  values  'x^,  'Xj  and  'Xj  are  set  dimensions, 
measured  from  the  clamped  end  of  each  link  (figure  2  and  3a) .  By 
using  the  Lagrange  polynomial  (14)  in  conjunction  with  the 
equations  defining  the  small  deflection  theory  of  beams,  other 
polynomials  are  derived  which  describe  the  axial,  rotational, 
torsional  and  flexural  displacements  of  each  link.  The  shape 
function  'L  mJ  »'L  used  in  the  Lagrange  polynomials  are 

formulated  below: 

(‘x-^Xj)  (‘x-'Xj) 

'N,—- : — - — - — : -  (15) 

Cx^-'x,)  Cx^-’x,) 

(‘x-‘x,)  (‘x-^Xj) 

— - — — - - 

(■Xj-'x^)  CXj-'Xj) 

Cx-'x.)  Cx-'x,) 

'^Z - - - - — - - 

CXj-'x^)  ('X3-'X2) 

1.1  Aacial  Oiaplaceaeats  In  Local  'x  Oireetioa 


The  required  combination  of  strain  gage  readings  (f»l) ,  for 
the  determination  of  the  axial  displacement  'u  are  shown  below: 


‘  li 

(i=2,3) 

(j-lr2,3) 


(16) 


In  this  equation,  the  individual  single  element  strain  gage 
values  which  make  up  the  strain  gage  set  at  location  '(x  )  "are 
further  described  as:  ‘ 


[positive  y  face  position  1  (figure  3b)] 

I'Cj  [positive  z  face  position  2  (figure  3b)] 

'*€3  [negative  y  face  position  3  (figure  3b)] 

[negative  z  face  position  4  (figure  3b)] 

From  equation  (15)  ^e  axial  displacement  'u,  determined  from 
the  strain  measurements  is  obtained  by  integration: 

d'u 

I  Nj‘,{e,.)  (17) 

d'x 

Therefore: 

'u-',{  €j)/^‘LMjdx»'b,+'b2'x+'b3*x^+'b^'x’ 
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1.2  Flexural  Displacements  Zn  Local  '7  Direction 

The  required  combination  of  strain  gage  readings  (C»2)  for  the 
determination  of  the  flexural  'v  displacements  is  shown  below: 


1 

2 


(18) 


(i=2,3) 

(j-1,2.3) 

where: 

'*€,  [positive  y  face  position  1  (figure  3b)  ] 
''e,  [negative  y  face  position  3  (figure  3b)  ] 


The  bending  strain  varies  with  the  bending  moment  which  varies 
along  the  length  of  the  link,  therefore,  the  bending  strain  is 
determined  at  each  '{Xj}  from  the  strain  gages.  From  equation  (15) 
the  flexural  displacements  'v  are  obtained  by  integration: 


where: 


i 


v« 


d^  ‘v 
d'x^ 


-  iNj’ate.) 
h 


^  i 


(€ 


t_Njdxdx 


*C,+*C2*X+'C3*X^+’c^’x^+'c5'x‘ 


( 19) 


or 


*2  *  *3 

•x* 

TT 

T 

T 

(' 

‘x.-‘ 

‘3> 

r  1  4 

i 

*  — 

*  ( 

*1  '  ‘3 

*•  1 

TT 

T 

T 

(‘ 

M)( 

'*3- 

j 

«i>‘ 

X  'x 
*3 

X* 

TT 

T 

T 

«3-‘ 

«x)( 

‘«3-‘ 

*3) 

2*1 


(20) 


2*31 


From  the  boundary  conditions  at  x»0,  the  constants  of 
integration  (Cj=C^=0)  are  obtained. 

It  should  be  again  noted  that  the  fourth  order  polynomial 
derived  above  will  exactly  describe  the  static  deflected  shape  of 
each  robotic  link  with  applied  concentrated  loads  and  reaction 
couples  as  well  as  unifoirmly  distributed  loadings.  Flexural 
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displacements  in  the  local  'z  are  derived  in  a  similar  manner. 

1.3  Torsional  Rotational  Oiaplaeamants  Zn  Local  'x  Direction 

A  torque  applied  to  a  link  will  induce  a  shearing  strain  in 
that  link.  The  links,  made  of  structural  steel  txibing,  are 
considered  thin  walled  tubes.  For  thin  walled  tubes  of  constant 
thickness,  the  shearing  strain  due  to  applied  concentrated  torques 
is  constant  for  the  full  length  of  each  link.  To  determine  the 
shearing  strain,  two  rosette  strain  gages  are  mounted,  one  on  the 
positive  y-face  and  one  on  the  negative  y-face  of  each  link  at 
location  'x^  (figure  2  &  3a)  .  It  should  be  noted  that  mounting 
rosettes  on  the  positive  and  negative  z-faces  would  also  give  the 
same  results.  Each  rosette  is  a  cluster  of  three  single  element 
strain  gages  oriented  in  the  local  'x'z  plane  at  angles  and 

'^3  (figxire  4).  Opposite  face  single  element  strain  gages  in  each 
rosette  are  oriented  in  the  same  directions.  Two  rosettes  per  link 
i  are  necessary  to  temperature  compensate  and  properly  determine 
the  torsional  shearing  strain.  The  strain  at  any  arbitrary  angle 
in  two  dimensional  space  on  the  surface  of  the  steel  tube  is 
defined  in  terms  of  the  local  cartesian  strains  as  shewn  below 
[Popov,  1952]: 

‘€^»‘€^cos^(‘lr)+*€jSin^('>)+'Y„sin'Tjrcos‘iJr  (21) 


(i-2,3) 

where: 

Of  Is  defined  as  an  arbitrary  angle  measured  from  the  'x  axis 
(figure  4) . 

For  a  three  element  strain  gage  cluster  or  rosette,  three 
simultaneous  equations  may  be  written  to  describe  the  strain  in 
each  strain  gage  element  for  each  corresponding  angle  'f,, 

i  i  i 

The  strain  values  '*3  determined  experimentally 

from  the  strain  gages  ana,  therefore,  are  known  values.  To 
minimize  cosmutational  work,  three  element  rosette  gages  with 
'f2»45  ,  and  '^3*90°  were  chosen  for  the  laboratory  model. 
This  type  of  rosette  is  also  known  as  a  rectangular  or  45'’  strain 
rosette.  By  direct  substitution  of  >2*45^,  and  >3=90*’; 

and  are  determined  as  shown  below  for  a  rectangular 

rosette: 


-  (‘S,  + 


(22) 

(23) 

(24) 


From  the  torsional  shear  strain  'y,,/  the  rotational  displacements 
'9  are  determined  in  the  local  coordinate  system  as  shown  below: 


‘9. 


h 


2LL 

h 


i  {2N 


-  (‘S,  +  ’«.i) 


0^ 


(25) 


1.4  Rotational  Bending  Displacements  Zn  Local  iy  Direction 

The  required  combination  of  strain  gage  readings  (£=>3),  for 
the  determination  of  the  rotational  -'9^  and  'w  displacement  is 
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shown  below: 


(26) 


(i-2.3) 

(j-1,2,3) 

where : 

’■fij  [positive  £  face  position  2  (figurt.  3b)] 
[negative  z  face  position  4  (figure  3b)  ] 


The  rotational  displacements  -'6^  derived  from  the  strain 
measurements  'slCj)  are  defined  below.  ^The  negative  sign  in  front 
is  required  for  consistency  with  the  right-nand  rule  sign 
convention.  f 

-'0..  »  d!w  -  \{£:}i  Jl  MJdx  (27) 


y  ‘3{£.)i/l  MJdx 

d'x  ^  J  * 


where: 


’-«0y  -  *f,+*f2*x+*f3‘x2+*f^'V 


or 


-$  «  • 
y  - 
h 


i  ,3  i 


x''-'x“(  'x2+'x3)  +  ‘x2‘x3‘x 


I  -  i  ^  I 


{  ‘  X,-'  X,  )  (  '  X,-'  X.  ) 


3*1 


(  231 


x^— *  x*( 'x^  +  ‘x3)  +  *xj'x3'x 


(  '  X2'”  *  1  )  (  '  *2”*  *3  ^ 


3*2 


'x^-'x^( 'xj+'x2)+'xj'x2‘x 


I  ( ' Xj-* x^ ) ( ‘ x3-‘x2) 

From  the  boundary  conditions  at  x=0,  the  constant  of 
integration  (Cj^O)  is  obtained.  Rotational  bending  displacements 
in  tne  local  'z  direction  is  derived  in  a  similar  manner. 

2.  Joint  Displacements 

2.1  Joint  Displacement  Notations 

The  displacement  equations  developed  using  the  Lagrange 
polynomials  exactly  describe  the  static  deflected  shape  of  link  2 
and  3,  as  previously  noted.  In  order  to  determine  the  deflected 
and  rotated  position  of  the  end  effector,  all  joint  displacements 
and  all  rigid  body  motion  displacements  must  be  determined.  The 
joint  displacements  at  the  ends  of  link  2  and  3  in  the  local 
coordinate  systems  can  be  determined  from  the  displacement 
equations  developed. 

Special  notations  are  required  to  help  clarify  the  many  local 


3*3 
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displacemen'ts  at  each  joint  analyzed  in  this  and  the  following 
subsections.  Where,  for  example,  '^Vj,  corresponds  to  the 
displacement  in  the  'y  direction  at  joint  i  for  condition  s 
( S*1 ,2,3. . .6)  • 

i  Defines  the  link  number. 

i  Defines  the  joint  ntuaber  at  which  the  displacements  are 

determined  ( i »  2 ,  3 , or  4 ) . 

s  Is  a  displacement  designation  developed  to  simplify 

programming  notation  and  to  allow  for  a  method  of  separately 
calculation  displacements  due  to  rigid  body  motions  where: 

s»l  For  the  displacements  determined  from  the  strain  gage 
values . 

ss2  For  the  displacements  from  rigid  body  motions  in  the 
'x'y  plane. 

s»3  For  the  displacements  from  rigid  body  motions  in  the 
'x'z  plane. 

s«4  For  the  displacements  from  rigid  body  motions  from 
rotational  displacements  equations  '0^,  '8^,  and  '6.. 

s»5  For  the  displacements  from  rigid  body  motions  from 
actuator  fluctuations. 

In  order  to  find  joint  displacements  \u, ,  \v, ,  '^w, ,  ',6^, ,  \0^, 
the  length  L,  of  link  i  m\ist  be  substituted  for  the  'x  terms  in  the 
displacements  equations  in  addition  to  inputting  the  set  location 
values  '(Xj)  and  the  strain  gage  combination  values  '({Cj}*  To  find 
the  remaining  joint  displacements  the  length  L,  of  link  i,  the 
out  to  out  dimension  of  the  link  h,  and  the  strain  values  '(£,{}  are 
substituted  into  equation  (25) . 

2.2  Rigid  Body  Motion  From  Joint  Displacements 

Rigid  body  motion  effects  (RBME)  are  translational 
displacements  and  rigid  body  rotational  displacements  resulting 
from  adjoining  link  joint  displacements.  All  articulated  robot 
manipulators  of  more  than  one  link  experience  rigid  body  motions 
which  are  a  function  of  the  number  of  degrees  of  freedom  of  eac.t 
joint.  It  is  to  be  understood  that  the  rigid  body  effects  are 
first  determined  in  the  local  coordinate  system  and  then 
transformed  to  the  global  coordinate  system  before  being  combined 
with  other  global  displacements. 

2.3  Rigid  Body  Motion  Effects  In  The  Local  'x'y  Plane 

The  RBME  in  the  local  xy  plane  result  from  the  joint 
displacements  ^jV,,  and  at  joint  2  and  3.  Joint  2  is 

considered  pinned  in  the  local  and  global  XY  plane.  Therefore,  any 
flexural  displacement  at  joint  2  results  in  only  a  rigid  body 
translation  of  joint  3  and  end  effector  center  point  (EECP)  4 
(figure  7).  Similarly,  a  flexural  displacement  ^jV^  at  joint  3  will 
result  in  a  rigid  body  translation  of  EECP  4.  However,  since  joint 
3  is  rigid  in  the  global  XY  plane,  the  rotational  displacement  ^.0^^ 
which  accompanies  the  flexural  displacement  ^jV^  at  joint  3  results 
in  an  additional  rotation  of  the  end  effector  link  and  ultimately 
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a  change  in  the  position  of  EECP  4.  It  is  to  be  noted  that  there 
are  no  out  of  plane  RBME  associated  with  these  pazrticular 
displacements.  Therefore,  The  displacements  in  the  'z  direction 
are  not  indicated  in  this  section. 

A  positive  flexural  joint  displacement  at  the  end  of  link 
2  at  joint  2  causes  joint  2  to  move  to  2',  joint  3  to  move  to  3 ' , 
and  joint  4  to  move  to  4',  (figure  7).  This  represents  RBME  in 
translation  of  joint  3  and  joint  4  as  defined  below: 


jU'*  (29) 

jV-  2^v,cos(02-^,)  (30) 

2^v,sin(^-0,)  (31) 

^V-  2^V,COS(03-^,)  (22) 


where  the  superscript  4  indicates  the  local  rigid  body 
displacements  at  the  EECP  4. 

A  positive  flexural  displacement  ^^v^  at  the  end  of  link  3  at 
joint  3  causes  the  joint  at  3'  to  move  to  3**  and  the  EEC?  4'  to 
move  to  4”  (figure  3).  This  represents  RBME  in  translation  of  EEC? 
4  as  defined  below: 

4U''=  ^3V,sin(03-<A2)  (33) 

^V«-  2jV,COS(<^3-02)  (24) 


Since  joint  3  is  considered  rigid  in  the  'x'y  plane,  a 
rotational  displacement  2^0^^  at  the  end  of  link  3  at  joint  3  results 
in  RBME  in  rotation  of  the  end  effector  link  (figure  7)  .  As  joint 
3  rotates  an  angle  EECP  4"  moves  to  4"'  (figure  7)  and  a  rigid 
body  rotation  of  the  EECP  4  also  occurs.  These  displacements  are 
defined  below: 

(35) 
(36) 


-V30,,sin(^30,,/2) 
L,^30^, cos  (^30^/2) 


,0,"' 


The  total  net  RBME  which  result  at  joint  3  and  EECP  4  from  the 
displacements  and  ^36 are  combined  below: 


-  jU* 

(38) 

-  3V 

(39) 

»  ^u'  +  ^u"  +  ^u"' 

(40) 

»  ^v'  +  ^v”  ^v” ' 

(41) 

‘.0,2 

-  48."  • 

(42) 

Similar  derivations  are  made  for  the  rigid  body  motion  effects  in 
the  'x'z  plane. 
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2.4  Rigid  Body  Motion  Effects  From  Rotational  Displacements  '^0^ 

The  local  rotational  displacements  '^6^  result  from  torsional 
moments  and  all  components  of  those  moments  and  forces  which  cause 
a  twisting  deformation  in  link  2  and  3 .  A  local  rotational 
displacement  or  twist  in  link  2  at  joint  2  will  result  in  a 
rotational  RBME  in  link  3  and  also  in  the  end  effector  link.  A 
local  rotational  displacement  ^36^,  or  twist  in  link  3 ,  by  the  same 
reasoning,  will  result  in  a  rotational  RBME  in  the  end  effector 
link.  The  RBME  associated  with  these  rotational  displacements  are 
described  separately  below: 

As  joint  2  rotates  the  angular  displacement  joint  2  moves 
to  3 ' ,  which  results  in  the  displacements  3U',  jV  ,  and  jW'  at  joint 
3  and  a  rigid  body  rotation  36,'  (figiire  9)  .  In  addition,  as  joint 
2  rotates  the  angular  displacement  end  effector  center  point 
(EECP)  4  moves  to  4',  which  results  in  the  displacements  ^u',  , 
and  4W'  at  EECP  6  and  a  rigid  body  rotation  (figure  9)  .  A  few 
of  the  displacements  relating  to  this  motion  are  described  below: 


jU'  a  R2sin(02“<>,) 

(42) 

’  ^2^x1=03(02-0,) 

where : 

R2  «  R,(cos(22®xi)~i*°) 

'  44 ) 

(45) 

As  joint  3  rotates  the  angular  displacement  ^,6^,  EECP  6'  moves 
to  6"  which  results  in  the  displacements  ^u” ,  ^v" ,  and  ^w"  in 
addition  to  a  rigid  body  rotation  at  EECP  4  (figure  10)  .  A  few 
of  the  displacements  relation  to  this  motion  are  described  below: 

4U"  a  RjSinCOj-Oj)  (46) 

40"*  ’  ^9„COS  (03-02) 

where: 

Rj  a  R,(  cos  (239.,) -1.0) 

(47) 

(43) 

In  summary,  the  net  effect  at  the  end  effector  in  local 
coordinates  at  the  EECP  4  from  the  RBME  associated  with  t.te 
rotational  displacements  '9^  are: 

V4  -  3«' 

(49) 

V,  a  jV 

(50) 

>4  -  3W' 

(51) 

S0.4  - 

(52) 

a  ^U" 

(52) 

(54) 

\0.4  -  40.'n0x’’ 

(55) 

(56) 

(56) 
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2.5  Rigid  Body  Motion  Effects  From  Actuator  Fluctuations 

Any  fluid  displacement  in  the  hydraulic  actuators  ab  and  de  on 
the  model  (figure  1)  will  induce  a  rigid  body  motion  effect  at 
joints  2,  3  and  the  end  effector  center  point  (EECP)  4.  Any  fluid 
displacement  in  the  hydraulic  actuator  at  the  base  link  l  is 
neglected  here,  therefore,  all  out-of-plane  displacements  are 
zero  and  not  shown. 

The  displacemfsnts  from  actuator  ab  are  determined  and  defined 
as  displacements  ’,u  ,  and  at  joints  2,3  and  EECP  4.  This 

derivation  is  shown  below  (figure  11): 

dg  -  S,£ESj_  -  d#,  (57) 

A,B^sin9 

where : 

9  “  (58) 

2 

C,  »  [Ai2+B^2_2A^B^C0Sf  (59) 

where : 

EER,  Fluid  displacements  in  units  of  strain  in  actuator  ab. 

B1  Dimension  (figure  11) . 

0  Set  angle  equal  to  tan'’ (6"/22")  =  .26625  radians  'figure  11)  . 

The  fluid  displacements  from  actuator  de  are  determined  and 
defined  as  displacements  '^u^  and  at  joints  2,3  and  EECP  4. 

This  derivation  is  shown  below  (figure  11) : 

d9  -  fijEEE^  -  (60) 

AjBjSin* 

Cj  »  cV'^'^Z^'^A^BjCos?]’'  (61) 

jU'  »  Ljdasin(do/2)  (62) 

The  other  displacements  are  derived  in  a  similar  manner. 


Where: 

ERRj  Fluid  displacements  in  units  of  strain  in  actuator  de. 

1  Angle  at  joint  2  set  at  126.87®=a2.214  radians  (figure  ll)  . 


The  combined  displacements 
actuators  ab  and  de  at  joints  2 


Vs 


3“s 


^  V 

3^5 


4^^ 


Vs 


due  to  the  fluid  displacements  in 
and  3  and  the  EECP  4  are: 


(63) 

2^' 

(64) 

jU'+jU" 

(65) 

jV'+jV" 

(66) 

4U '  +^u'' 

(67) 

^v'+^v" 

(68) 

2.6  Summary  of  Joint  Displacements 
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In  svunmaxy,  the  joint  displacements  at  the  ends  of  link  2  and 
3  in  the  local  coordinate  systems  can  combined  with  all  additional 
local  joint  displacements  due  to  rigid  body  motion  effects  as  shown 
below:  6 

\u  «  (69) 

s»l 

6 

S*1 

(1-2, 3, 4) 

Other  displacements  are  summed  in  the  same  manner. 

3.  Local  to  Global  Coordinate  Transformations 


To  be  of  use  to  the  controller,  the  local  displacements 
determined  in  the  above  discussion  need  to  be  combined  and  then 
transformed  from  the  local  coordinate  systems  to  the  global 
coordinate  systems,  before  combining  with  any  additional  glooal 
displacements,  in  order  to  determine  the  location  of  t.he  end 
effector.  Upper  case  notation  is  used  to  define  t.he  global 
displacements  and  lower  case  notation  is  used  to  define  t.he  local 
displacements  (figure  5  &  6) . 


where: 


0 

c 

-s  o  0 

0 

0 

i 

« 

V 

s 

coo 

0 

0 

9 

w 

m 

0 

0  1  0 

0 

0 

• 

W 

•x 

0 

0  0  c 

-s 

0 

•y 

0 

0  0  s 

c 

0 

'r 

*z 

0 

0  0  0 

0 

1 

» 

'x 

C  Cosine  of  joint  angle  ♦^[cos(*J]. 

S  Sine  of  joint  angle  ♦j[Sin(#,)]. 
i  Defines  the  joint  number  (2,  3,  or  4) . 


(71) 


4.  The  Experimental  Setup 


The  strain  gages  have  been  mounted  on  the  robot  and  tested 
under  static  loading  conditions.  The  measured  displacements  of  the 
end  effectors  are  within  2-3)  of  the  computed  displacements  using 
the  output  of  the  strain  gages.  A  dynamic  data  acquisition  system 
capable  of  1000  scans  per  second  is  being  tested  for  active  on  line 
control  of  the  robot. 


5 .  Conclusion 


The  dynamic  response  of  a  three-link  flexible  robot  using  sets 
of  strain  gages  and  rosettes  has  been  for  mulated  and  Lagrange 
polynomials  are  used  in  the  analyses  to  interpolate  a  strain  field 
and  then  integrate  it  to  obtain  the  3-D  displacements  and  rotations 
of  the  joint.  Geometrical  expressions  were  derived  to  sum  up  all 
flexibility  and  rigid  body  motions  to  predict  the  actual 
displacements  of  the  end  effector. 
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